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(54) MOVEMENT TRAJECTORY CONTROL METHOD FOR BIPEDAL WALKING ROBOT 

(57)Abstract: 

PROBLEM TO BE SOLVED: To provide a movement 
trajectory control method for a bipedal walking robot 
that can generate a pattern in the middle of walking, 
generate a real-time walking pattern and realize follow- 
up motion after a human by clarifying a parameter with a 
small effect on walking in compensatory trajectory 
generation and remarkably shortening compensatory 
trajectory generating time. 

SOLUTION: The movement trajectory control method 
for a bipedal walking robot computes a moment- 
compensatory trajectory of each joint for a trunk region 
and a waist region separately, decides moment- | 
compensatory trajectory computing algorithm 
considering cooperation between the trunk region and 
the waist region, and uses it to prepare a walking pattern 
on a real-time basis in the middle of walking. 
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t, >r -b >if A;'3 <t j£5tmjIi^S©K^Koi. ^riiiwr 

cn^©i':^f-At8fiK?:S 1 2(Cn^-r. 
[0101] ( 1 ) fiXt»«A;^->xf-A{co(,i-c 
WKtt«©A:^*^6S5felli»^«S-ewJiiT©<i: "5^cit 

[0 102] (-<) i-r. ^^^fga^^B^^^c^^•;/+>^^t- 
i^ 3 >©»]3Wf bte J: 0*iiSa^.^.©fiS*tf 0 . jil0^.#.©fi 

50 immMm<Dm^iiMm^. t u tc. 



(11) 
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[0103] ( P ) S,9iMli^m<Dfclt>K.Un-^ >-9-*^ * 

CO 1 0 4 ] t^*x5^-fr-igiit*, xfu^mtcjcsii 10 

[ 0 1 0 5 ] C n«. 1 r><r>t) jt ^±*>6 2 
[0107] dV, = V,-V,. 

dVi = Vi-V,, (3. 1) 20 

[0 10 8] 

F, = G, (dV.-dV,) (3. 2) 

F. = G. (dV,-dV,) (3. 3) 



2002-346957 
20 

[01091c c-e. V„. V,. ; ii!»*©ttWfii 

v.. V, ; mn^jiom^m 

dV.. dV, ; »J»Jiiii3HSfii<D^ 

F, ; m\k-n'^^n 

F. : A:>b/?|6] ^t§ 

[0 1 10] (^^) i^^$n/c^i|ii5:fflC>TS5fe»*5J: 

[0111] (2) ^^A;^2^;=^T-A{c-:>tir 

^*ifft)n^. cc-c»— {^iur, mi. ^. 

mm. ^iKlHl. *j<fcO'(?±08iS©;?^* 

[0 112] 
[«3] 





Sagittal m 


Coronal m 


Trunning deg 




o\ 1 O 


O. O O 


O. O O 




— O . 1 O 


O. O O 


O. O O 




O . O O 


— O. OS 


O. O O 




O. O O 


O. O 5 


O. O O 




None 


None 


— 5. O O 




W o n e 


None 


5 . O O 




O . O O 


O. O O 


O. O O 


f»Jh 


None 


None 


None 



[01 13] C©^-CN one i»^?S©*ifi«: 

[0 114] \ikkXm>icWA<DU^%sX.lMZ 



[0 115] 
[«4] 



(12) i|$gg200 2-3 46 957 

21 22 



to 1 1 6 























fr^lX/.y,.*,! 












fin jm #v> r 








T^lT,,Ty.Tj 


2MP JC*l«t6JlcSy?*— > V h 






















































] * * [^5] 


m, 








"V 
















it 








:^,) tiR»m(cBi^«iia«»-t*»»;&r^tr^. 







[0 117} cifciO. i^tf4'©>'-''i'->^>c*5ifj^cc^c0. ';t 
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23 



[02] b^-vy-r Ka;J<':» KDSM^^ffiS^^fcJ: 

[05] 2St Kn;K^» h©TteSiJ»©*tf 

y ^• - > ^r^-r Eir* -5. 

[06 ] igyT/bif-r A/^•^^->^^Je©■7^-?•■^' 20 
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[07] i^^'o<Dmm^mm^pL?>Bmimmr^ 
[0 8] (Dmmfimfic^^ ?,m^i:^mr?, 

fc*©X - ZMP*iijl?:^nf 0t?*S. 

[09] 1 0 ©ta?»*i^'ff S^S*tiiWr -5 
fc*©Y - Z M P«iji«7n-r0r*€>. 

[010] 1 D ©tl!^A5i^tT(C-^^ Si?S?:Siia-r 

[011] 2Sb:*— y-y-f KciJi^:' h©&fl,'^.©a« 
[012] ^^^^fce^^UTJUi^-r A/^•5^->^fiX©i^ 

;^ f- A^{*©i£n?r^-r 0 -c* . 
[^?#©SiW] 
X P-;H4 
Y f 
Z 

0-XYZ XW*>J:0'Y$t^^tf¥EA5jgffiic-gc 
O. 8gffifcSiS^ctJ4Zai<bLt:Jl,'^.*58SB4ca5e3tl 

O' -X' Y' Z' Hlj^.^st A-vy-r Ka;i<»>- h© 



mi] 



[02] 



[03] 





inu/2 




( nriT = rntn + mu ) 



[05] 



[06] 



giMnai<oigg"~l 



its 



X 



(14) 
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m4] 



mi I] 



(start) 



E>»w^i«,fa-o>o>i,/2 



L 



I 



M*«Am(D FFT 



^(tf-yyttl.a-ji.m)/ /(( 



FFT a&FFT I 





Left Arm 



END 



mi] 




TIMECW 




(15) 



^fga2 0 0 2-3 46 95 7 



m9] 



mio] 



0.15 




TliE(W 



[012] 



fW3n [g!j^ 



Iiagzi>hp-;U 




TIME(^) 



mMlfSSfflKBIS 4-20-3 bOl. 
301-^ 



F ^ - A C##) 3C007 AS36 CS08 KS39 KTOl LV12 
WA03 WA13 WB05 WB07 WB17 
WB19 



